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The  attitude  determination  and  control  subsystem  requirements  of  various  payloads  on 
the  FalconSAT-3  satellite  are  stringent  enough  to  demand  some  type  of  data  processing  in 
order  to  meet  attitude  determination  requirements.  This  paper  details  one  data  filter,  the 
Kalman  filter,  and  more  specifically,  the  7-state  and  6-state  Kalman  filters.  Both  filters 
prove  to  meet  the  attitude  determination  requirements  successfully  with  little  difference  in 
achieved  accuracy.  However,  the  6-state  filter  places  much  less  computational  demand  upon 
the  on-board  computer.  Based  upon  this  data,  the  6-state  filter  is  a  more  logical  choice  for 
the  FS3  attitude  determination  and  control  subsystem  filter.  However,  there  is  still  much 
analysis  that  needs  to  be  completed  before  a  final  verdict  might  be  reached.  This  paper 
examines  both  of  these  Kalman  filters  from  a  theoretical  standpoint  before  examining 
practical  implementation  and  concerns  therein. 


Nomenclature 


A(x) 

= 

attitude  matrix  (transition  matrix) 

I 

= 

inertia  tensor 

N 

= 

disturbance  torques 

P 

= 

covariance  matrix 

= 

quaternion 

T 

1  BYLO 

= 

attitude  matrix  (transition  matrix) 

X 

= 

propagated  “x”  vector 

X 

= 

corrected  “x”  vector 

X 

= 

state  vector 

Sqn 

= 

differential  quaternion 

Sco 

= 

differential  angular  rate 

®By 

= 

Euler  body  rates  wrt.  inertial,  \cox  cor  co 

= 

Euler  local  orbital  rates  wrt.  inertial,  [ coox  i 

mean  motion  of  the  Earth,  [0  —  CD  0]( 

*  Cadet  First  Class,  Department  of  Astronautics,  PO  Box  4008 

CO 


oy 


co„ 


’  Professor,  Department  of  Astronautics,  USAF  Academy  CO  80840.  AIAA  Associate  Fellow 
'  Schriever  Professor,  Dept,  of  Astronautics,  USAF  Academy  CO  80840.  AIAA  senior  Member 
1  Chief  ADCS  Engineer,  Surrey  Satellite  Technology  Ltd.,  Guildford  Surrey  GU2  7XH,  United  Kingdom. 


1 

American  Institute  of  Aeronautics  and  Astronautics 


I.  Introduction 

N  1990  the  Space  Systems  Research  Center  (SSRC)  was  founded  to  enable  cadets  at  the  United  States  Air  Force 
Academy  to  fully  experience  the  complexity  of  satellite  design,  construction,  and  operation.  After  several 
successful  balloon-based  upper  atmosphere  experiments,  SSRC  initiated  the  development  of  operational  satellites 
for  Air  Force  research  experiments.  In  1997,  SSRC’s  FalconGold  satellite  bore  a  GPS  Signal  Experiment  into  an 
elliptical  orbit  above  the  GPS  constellation.  FalconGold  successfully  completed  its  mission  of  collecting  data 
showing  that  GPS  signals  can  be  received  above  the  GPS  constellation  and  be  utilized  for  orbit  determination. 
FalconSAT-1  was  launched  in  2000  to  assess  the  hazards  of  spacecraft  operations  in  the  wake  of  larger  bodies. 
However,  an  in-orbit  power  failure  prevented  the  successful  completion  of  this  mission.  FalconSAT-2  was  designed 
to  gather  data  concerning  the  effect  of  upper-atmospheric  plasma  bubbles  upon  GPS  signals.  Originally  designed  for 
a  2003  launch  in  conjunction  with  the  Space  Shuttle  Hitchhiker  program,  the  satellite  is  currently  being  re¬ 
engineered  for  an  alternate  launch  vehicle  due  to  the  probable  cancellation  of  the  Hitchhiker  program. 

FalconSAT-3  (FS3),  SSRC’s  current  satellite  design  endeavor,  is  a  50  kg  microsatellite  being  developed  by 
cadets  and  faculty  at  the  Air  Force  Academy.  FS3  will  carry  several  experimental  payloads  to  conduct  DoD 
research.  One  of  these,  the  Micro  Propulsion  Attitude  Control  System  (MPACS),  is  an  attempt  to  demonstrate 
pulsed  plasma  thruster  (PPT)  propulsion  technology.  The  Flat  Plasma  Spectrometer  (FLAPS)  and  the  Plasma  Local 
Anomalies  Noise  Environment  (PLANE)  experiments  are  further  attempts  at  characterizing  the  local  plasma 
environment.  A  shape  memory  composite  gravity  gradient  boom  and  a  shock  ring  vibration  suppression  system 
comprise  the  final  two  experimental  payloads  of  FS3.  The  satellite  is  scheduled  to  be  launched  in  the  Fall  of  2006 
for  a  projected  design  to  end-of-life  cost  of  approximately  $2  million. 

II.  FS3  ADCS  Architecture 

The  primary  challenge  for  the  FS3  Attitude  Determination  and  Control  System  (ADCS)  team  is  to  develop  the 
software  and  techniques  necessary  to  achieve  the  derived  attitude  control  requirements.  As  it  turns  out,  the  FLAPS 
experimental  payload  has  the  most  stringent  ADCS  requirements,  demanding  attitude  control  to  within  five  degrees 
of  the  ram  direction  with  respect  to  the  local  orbital  frame,  as  well  as  attitude  knowledge  to  within  one  degree.  FS3 
is  the  Air  Force  Academy’s  first  attempt  at  achieving  three  axis  attitude  control. 

FS3  attitude  sensors  include  one  Billingsby  Fluxgate  magnetometer  and  4  AeroAstro  medium  sun  sensors.  In 
conjunction  with  on-board  software  (some  of 
which  is  detailed  in  this  paper),  these  sensors 
will  provide  sufficient  attitude  knowledge  to 
meet  the  derived  requirements.  Attitude  actuators 
include  a  gravity  gradient  boom  for  passive 
attitude  control,  as  well  as  three  magnetorquers 
for  active  attitude  control.  The  boom  is  a  2.84 
meters  long  (to  the  center  of  gravity)  composite 
thermal  boom  with  a  7.8  kilogram  tip  mass, 
creating  a  transverse  moment  of  inertia  of  67.4 
kg-m-s2. 

As  part  of  the  ADCS  task,  a  Kalman  filter 
will  be  implemented  to  process  sensor  attitude 
date.  Generally  speaking,  the  Kalman  filter  is  a 
recursive  optimization  algorithm  that  generates 
an  estimate  based  upon  potentially  noisy 
observation  data.  At  the  most  basic  level,  the 
Kalman  filter  is  fundamentally  an  optimization 
problem  that  can  be  applied  across  many 
disciplines  to  predict  the  behavior  of  systems.  In 
astronautics,  the  Kalman  filter  is  often 
implemented  to  simplify  and  expedite  the  ADCS 
task.  For  FS3,  the  filter  must  balance  ADCS 
sensor  measurements  with  the  expected  attitude  generated  by  an  on-board  orbit  propagator.  For  several  reasons,  the 
Kalman  filter  is  implemented  in  this  process  rather  than  other  filtering  techniques.  Due  to  on-board  computer  (OBC) 
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Figure  1.  EKF  Mechanics,  One  Measurement 


limitations,  data  must  be  cyclically  processed  and  discarded,  rather  than  being  stored  for  access  during  each 
estimation  iteration  as  with  other 

filtering  techniques.  The  Kalman  filter  is  ideal  for  processing  large  amounts  of  data  in  this  fashion.  Attitude 
determination  presents  another  difficulty  that  is  addressed  by  the  Kalman  filter.  In  the  attitude  determination  task, 
three  independent  reference  parameters  are  needed  to  determine  attitude.  Each  vector  measurement  provided  by  the 
satellite  sensors  yields  two  reference  parameters.  Therefore,  the  typical  requirement  for  three-axis  attitude 
determination  is  two  vector  measurements.  Attitude  determination  with  two  measurements  is  overdetermined  while 
attitude  determination  with  one  parameter  is  underdetermined.  The  Kalman  filter  can  solve  either  the 
overdetermined  or  the  underdetermined  cases,  allowing  three-axis  attitude  determination  with  either  both  sun 
sensors  and  magnetometers  or  solely  magnetometers.  The  Kalman  filter  is  able  to  solve  the  underdetermined  case 
because  an  on-board  orbit  propagation  model  is  part  of  the  filter.  This  filter  utilizes  this  model  to  allow  three-axis 
attitude  determination  with  only  one  vector  measurement.  In  short,  the  robustness  of  the  Kalman  filter  enables  it  to 
be  applied  to  the  ADCS  task. 

The  estimation  of  the  Kalman  filter  operates  in  two  primary  cycles,  propagation  and  correction.  During  the 
propagation  cycle,  the  filter  propagates  the  state  of  the  system,  using  a  system  model  to  predict  the  state  of  the 
system  one  time  step  in  the  future.  The  correction  cycle  inputs  measurements  of  the  system  state  and  utilizes  these 
observations  to  correct  for  differences  between  the  state  propagated  from  the  system  model  and  the  measured 
satellite  state.  However,  the  correction  cycle  encounters  particular  difficulty  due  to  the  fact  that  some  amount  of 
noise  and  imprecision  is  embodied  in  the  measurements  themselves.  Therefore,  the  primary  task  of  the  Kalman  filter 
correction  cycle  is  to  balance  the  state  propagated  from  the  system  model  with  the  system  state  derived  from 
measurements  utilizing  optimization  theory.  This  correction  process  yields  a  ‘corrected’  estimate  of  the  system  state. 
As  the  filter  iterates,  this  corrected  state  estimate  is  utilized  as  the  initial  condition  for  the  Kalman  filter  propagation 
cycle. 

Figure  1  offers  a  pictorial  representation  of  basic  Kalman  Filter  dynamics.  Notice  that  the  covariance  matrix  is 
propagated  and  corrected  as  well.  This  matrix  contains  information  essential  to  the  optimization  process,  and 
therefore  must  be  included  in  the  propagation  -  correction  process. 

However,  FS3  attitude  knowledge  hardware  includes  both  a  magnetometer  and  a  sun  sensor.  Hence,  two 
measurements  are  entered  to  the  filter  when  the  satellite  is  illuminated.  This  does  not  significantly  affect  the  basic 
filtering  process,  yet  it  merits  discussion.  Magnetometer  measurements  are  assumed  less  accurate  than  the  sun 
sensor  measurements.  Therefore,  magnetometer  measurements  are  first  entered  into  the  correction  cycle  of  the  EKF, 
resulting  in  a  ‘corrected’  state.  Subsequently, 
before  returning  to  the  propagation  cycle,  the  sun 
sensor  measurements  are  entered  into  a  second 
iteration  of  the  correction  cycle,  yielding  the 
further  ‘corrected’  state.  The  diagram  below 
offers  a  pictorial  representation  of  the  dynamics 
of  dual  measurement  input  to  a  Kalman  Filter. 

For  ADCS,  Kalman  filtering  involves 
propagation  of  the  satellite  attitude  and 
covariance  matrices  using  both  Euler’s  moment 
equations  and  a  basic  knowledge  of  the 
disturbance  torques  acting  upon  the  satellite. 

Subsequent  to  this  propagation,  the  Kalman  filter 
adjusts  the  propagated  attitude  and  covariance 
matrices  based  upon  the  measurement  vector(s). 

Because  the  attitude  motion  of  FS3  will  be 
nonlinear,  extended  Kalman  filters  (EKF)  will  be 
necessary  to  accommodate  nonlinearities.  This 
paper  will  detail  the  various  filtering  schemes 
explored  for  optimal  application  in  the  FS3 
ADCS  task. 

III.  Seven  State  EKF 

The  EKF  most  commonly  implemented  in  the  ADCS  task  is  the  7-state  EKF.  This  is  due,  in  part,  to  the  relative 
ease  of  7-state  mathematics  in  comparison  with  other  Kalman  filters  that  have  been  utilized  for  spacecraft 


Figure  2.  EKF  Mechanics,  Two  Measurements 
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operations.  In  addition,  the  7-state  fdter  has  well-established  reputation  as  an  effective  and  reliable  estimation 
technique. 

A.  Theoretical  Detail 

For  the  7-state  filter,  the  state  vector  defines  not  only  the  attitude  of  the  satellite,  but  also  the  rates  at  which  the 
attitude  is  changing.  The  7-state  EKF  state  vector  is  comprised  of  the  four-element  quaternion  attitude  vector 

combined  with  the  three-element  body  rates  vector,  with  respect  to  the  inertial  frame  (p)^, ) .  Symbolically,  this  state 

vector  can  be  represented  as 


x  =  [q  1  q  2  q  3  q  4  (Ox 


co„ 


co_ 


(1) 


During  the  propagation  cycle  of  the  EKF,  the  quaternion  and  angular  rate  components  of  the  state  vector  are 
propagated  separately.  The  quaternions  are  propagated  forward  in  time  utilizing  the  basic  quaternion  dynamic 
equation,  specifically 
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The  body  rates  are  propagated  forward  in  time  utilizing  Euler’s  Moment  Equations,  specifically 

Icb  =  N  -COX  I  CO 


(7) 


Simple  numerical  integration  is  utilized  to  propagate  the  quaternions  and  body  rates  one  time  step  in  the  future. 

With  these  definitions  in  mind,  the  basic  mathematical  process  for  7-state  Kalman  Filtering  can  be  detailed 
below.  Note  that  several  equations  integral  to  the  operation  of  a  Kalman  Filter  are  here  overlooked  in  order  to 
simplify  the  presentation.  Many  others  have  presented  the  EKF  in  much  more  detail,  and  the  omitted  equations  may 
be  found  in  these  works. 


Flashida,  Yoshi.  ADCS  for  Future  UoSat  Standard  Platform:  REVISION  2.  SSTL  Internal  Technical  Note. 

SSTL,  Guildford,  Surrey,  United  Kingdom:  2004. 

Plessis,  Roger  M.  Poor  Man’s  Explanation  of  Kalman  Filtering  or  How  I  Stopped  Worrying  and  Learned  to  Love 
Matrix  Inversion.  Rockwell  International,  CA:  June  1997. 
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B.  7-State  Kalman  Filter  Mathematical  Process 

x  =  [qx  q2  <h  ch  0)y 


P  -  covariance  matrix  (7  x  7) 

<I>  -  state  transformation  matrix  (7x7) 

Q  -  process  noise  covariance  matrix  (7  x  7) 


K  -  Kalman  gain  matrix  (7x3) 

R  -  measurement  noise  covariance  matrix  (3  x  3) 
H  -  observation  matrix  (3  x  7) 


F  -  mathematical  convention  (7x7)  t  -  time 

Z  -  measurements  of  system  state,  either  sun-sensor  or  magnetometer 
Zhy  -  body  referenced  measurements,  directly  from  onboard  sensors 


Zlo  -  orbit  referenced  measurements,  from  orbit  model  prediction  (IGRF) 


A.  Propagation  Cycle 
1 .  Covariance  Propagation 

4+1  =  ®/t+l4®£+l  +  0Jt+l 
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B.  Correction  Cycle 
1 .  Compute  Observation  Matrix 
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2.  Compute  Kalman  Gain  Matrix 

k,=p,h'\h,p,K+k]' 

3.  Update  State 

4+ 1  =  Xk+ 1  +  Fk+i  ( Zby  —  TBYLOZlo  ) 

4.  Update  Covariance 

A,  = 


A-+1 


This  basic  EKF  process  has  introduced  several  variables  that  merit  further  explanation.  The  covariance  matrix 
( P )  essentially  is  a  time -referenced  estimate  of  the  accuracy  of  both  the  system  model  and  the  measurements.  The 
correction  cycle  depends  heavily  upon  these  accuracies  in  order  to  determine  how  much  to  ‘trust’  either  the 
propagated  state  or  the  entered  measurements.  The  state  transformation  matrix  (cp)  is  an  approximation  of  the 

change  that  the  state  undergoes  over  the  specified  time  interval.  The  process  noise  covariance  matrix  {(J'j  is  derived 
from  the  expected  error  in  the  filtering  process.  The  observation  matrix  ( H )  is  a  measure  of  how  dependent  the 
measurements  are  upon  the  state  of  the  system.  The  measurement  noise  covariance  matrix  ( R )  entails  the  expected 
error  in  the  states  themselves,  derived  from  the  precision  of  the  system  model. 

It  is  important  to  note  several  key  aspects  to  the  filtering  process.  Notice  that  the  covariance  matrix  is 
propagated  in  addition  to  the  actual  state.  In  the  cyclic  pattern  of  the  EKF,  the  filter  utilizes  only  the  covariance 
matrix  and  state  from  the  previous  iteration,  which  means  that  a  relatively  small  amount  of  stored  data  points  will 
enable  filter  operation.  This  greatly  reduces  the  computational  demand  of  the  filter.  This  is  especially  useful  because 
the  covariance  matrix  and  the  state  vector  contain  all  the  information  concerning  the  status  of  the  system  that  is 
necessary  for  accurate  system  modeling. 

Another  aspect  worthy  of  note  requires  a  basic  understanding  of  the  onboard  application  of  the  EKF.  Onboard 
FS3,  the  EKF  will  input  sensor  measurements  every  five  seconds.  Since  the  correction  cycle  occurs  only  once  for 
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each  set  of  measurements,  the  propagator  must  propagate  the  system  state  five  seconds  in  the  future,  the  point  at 
which  the  next  set  of  measurements  will  be  entered.  However,  the  propagation  cycle  entails  the  numerical 
integration  of  the  system  state  over  this  time 
period,  which  is  the  heaviest  computational 
demand  placed  by  the  system  on  the  onboard 
computer.  In  order  to  reduce  this  computational 
demand,  a  simplified  numerical  integration 
technique  may  be  introduced,  as  long  as  the 
resultant  error  is  within  acceptable  bounds. 

Integration  time  step  may  also  be  decreased  in 
order  to  reduce  the  computational  demand, 
contingent  upon  acceptable  error  bounds. 

As  noted  previously,  if  sun  sensor 
measurements  are  entered  to  the  filter  in  addition 
to  the  magnetometer  measurements,  the 
correction  cycle  must  be  repeated  twice.  The  first 
iteration  will  update  the  state  derived  from  the 
most  recent  propagation.  The  second  iteration, 
utilizing  sun  sensor  measurements,  will  update 
the  ‘corrected’  state  derived  from  the  first 
iteration  of  the  correction  cycle.  Both  the  single 
and  double  correction  EKF  cycles  are 
represented  pictorially  below. 

IV.  Six  State  EKF 

The  7-state  EKF  presents  an  optimal  means  of  attitude  control  for  small  satellites.  However,  the  7-state  EKF 
necessarily  involves  many  7x7  matrices,  placing  a  fairly  heavy  computational  demand  upon  the  onboard  computer 
of  the  typical  microsatellite.  Hence,  any  means  of  significantly  reducing  the  computational  intensity  of  the  EKF 
while  not  sacrificing  operability  is  highly  desirable. 

Recentely,  Surrey  Satellite  Technology  Ltd.  developed  a  6-state  EKF  that  attempts  to  realize  this  goal. 
Developed  for  BilSAT,  a  Turkish  satellite  member  of  the  international  cooperative  effort  of  the  Disaster  Monitoring 
Constellation,  initial  development  of  this  6-state  EKF  began  in  2003.  Currently,  BilSAT  is  the  only  satellite  known 
to  the  author  to  have  flown  this  ADCS  software. 

A.  Theoretical  Detail 

In  order  to  understand  the  theory  underlying  the  development  of  the  6-state  EKF,  it  is  first  necessary  to  touch 
upon  some  fundamental  quaternion  definitions.  In  quaternion  mathematics,  the  ®  operator  is  typically  defined  such 
that 
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-Pi 
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Pi 

Pi 
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Pi 

~  Pi 
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Pi 
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-  Pi 

-Pi 

Pa  _ 

3  a  _ 

where  both p  and  q  are  quaternion  vectors.  This  definition  is  intended  to  allow 

A{p)A{q ) = a(p  ®  q) 


(8) 


(9) 


Hashida,  Yoshi.  BilSat  Attitude  Estimator  Mathematical  Specification:  REVISION  2,  SSTL  Internal  Technical 
Note.  SSTL,  Guildford,  Surrey,  United  Kingdom;  2004. 
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where  a(  )  is  an  attitude  (transformation)  matrix.  This  relationship  proves  pivotal  to  the  derivation  of  many  of  the 
relationships  utilized  in  the  6-state  EKF.  Another  convention  utilized  extensively  in  the  6-state  EKF  is  Sq  and  8(0 , 
the  differential  error  notation,  which  represent  small  deviations  in  the  quaternions  and  body  rates,  respectively.  The 
formal  definition  of  these  parameters  is 


?*+1  =8q®<ik 
cok+l  =  0)k  +  Sco 


(10) 


The  CO  —  5(0  relationship  is  somewhat  intuitive  and  simply  understood,  whereas  the  q  —  Sq  relationship  may  not 
be  quite  so  intuitive.  However,  the  q  —  Sq  relationship  as  expressed  above  is  very  similar  to  the  simple  (0—5(0 
relationship,  just  made  more  complex  by  quaternion  mathematics. 

Strictly  speaking,  true  quaternions  are  always  normal,  that  is, 

q\  +  ql  +  q\  +  ql  =i 


In  order  for  the  q  —  Sq  relationship  to  hold  and  the  0  operator  apply,  Sq  must  be  assumed  to  be  a  true  quaternion. 
(As  the  filter  converges,  this  assumption  becomes  essentially  valid.).  Therefore,  it  follows  that  the  differential 
quaternions  apply  to  Eq.  11.  Namely,  that 


Sql  +  Sq\  +  5q\  +  5q24  =  1  (12) 

This  normalization  allows  any  three  Sq  terms  to  necessarily  define  the  fourth, 

Sq4  =  +yji ~  Sq [  -  Sq22  -  Sq]  (13) 


Note  that  this  assumption  defines  Sq4  as  positive.  This  is  acceptable  since  Sq4  is  a  differential  quaternion 
specifying  the  error  associated  with  the  estimated  quaternions,  and  the  magnitude  of  the  differential  quaternion  is  the 
essential  information  derived  from  the  differential  quaternions.  It  is  important  to  note  that  Sq4  is  a  differential 
quaternion;  therefore,  it  does  not  directly  specify  the  attitude  of  a  spacecraft.  This  assumption  (that  the  differential 
error  quaternions  meet  the  normalization  criteria)  is  a  significant  assumption  allowing  the  development  of  the  6-state 
EKF. 

In  the  6-state  EKF,  the  auxiliary  state  vector  is  introduced,  defined  as  the  differential  state,  specifically 


y  = 


Sq2  Scj.  5cox  Scov 


(14) 


Note  that  due  to  the  assumption  made  in  Eq.  13,  the  auxiliary  state  vector  is  comprised  of  only  6  elements.  Based 
upon  the  normalization  assumption  described  above,  and  if  higher  order  terms  are  ignored  (linearization),  it  can  be 
demonstrated  that  Sqx  =  Sq2  =  Sq2  ~  0  .  This  relationship,  in  conjunction  with  the  normalization  assumptions,  can 

be  applied  with  care  to  facilitate  the  simplification  of  a  7-state  filter  to  a  6-state  filter. 

Application  of  the  definitions  in  Eq.  10  to  the  7-state  EKF  equations  allows  the  development  of  the  following 
filtering  process.  Note  that  the  cross  matrix  definition  is  utilized  extensively  throughout  this  process.  The  cross 
matrix  is  defined  specifically  as: 
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0 


-a 


(15) 


axb  =  C(a)b 


0  -ax 
ax  0 


Two  distinct  state  vectors  are  utilized  in  the  6-State  EKF  process.  The  true  state  is  comprised  of  exactly  the  same 
elements  as  in  the  7-State  EKF  process,  specifically 


x  =  [ql  q2  q,  q4  Q)x  a)y  coz\ 

The  6-State  filter  also  introduces  the  differential  or  auxiliary  state,  which  is 

y  =  [sql  Sq2  &1,  So.  8(0 y  S0)z] 


(16) 


(17) 


Note  that  the  auxiliary  state  has  six  elements  rather  than  seven.  This  plays  a  critical  role  in  reducing  the 
computational  demand  of  the  6-State  EKF. 


B.  6-State  Kalman  Filter  Mathematical  Process 

x  =  [qx  q2  <h  q  4 

\Sq  j  -  differential  quaternions 
P  -  covariance  matrix  (6  x  6) 

O  -  state  transformation  matrix  (6  x  6) 

Q  -  process  noise  covariance  matrix  (6  x  6) 


y  = 


=  [(%  Sq  2  Sq3  8(0  v  8(0  v 


\8(o\  -  differential  body  rates 


K  -  Kalman  gain  matrix  (6  x  3) 

F  -  mathematical  convention  (6  x  6) 
F[  -  observation  matrix  (3  x  6) 


R  -  measurement  noise  covariance  matrix  (3x3)?-  time 
Z  -  measurements  of  system  state,  either  sun-sensor  or  magnetometer 
Zby  -  body  referenced  measurements,  directly  from  onboard  sensors 


Zlo  -  orbit  referenced  measurements,  from  orbit  model  prediction  (IGRF) 
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A.  Propagation  Cycle 
1 .  Covariance  Propagation 

4+ 1  =  ®/t+l4t®i+l  +Qk+ 1 


'  (?k+\  L  ) 
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AN„l=2C(m)c(BtI) 
u  =  A(q)[ 0  0  if 

2.  Propagate  State 

4+i 

x,+1  =  xA-  +  J  xdt 

4 

specifically 

j  4+i 

<4+i  =^k  +  2 


B.  Correction  Cycle 

1 .  Compute  Observation  Matrix 

dzh 


Hk  = 


- by 


dy 


f)T 

U1 BYLO  „ 

f)T 

U1  BYLO  „ 

dPBYLO  

_d{8ql) 

d{Sq2)  '° 

d(Sq2) 

dTBYLO  

f)T 

U1  BYLO  „ 

dPBYLO 

d{scoxr° 

o(Scov)  10 

d{Sa>, ) 

2  ■  C{TBYLCplo )  03;t3  ] 

2.  Compute  Kalman  Gain  Matrix 

3.  Update  Auxiliary  State 

9k+ 1  =  Ji+1  +  41+1  (Z&j’  ~PBYLOZlo) 
9k+ 1  =  ^i+1  (Z6+  ~  PBYLOZlo  ) 

4.  Update  Covariance 

4+1  =  (j 6x6  ~  K k+\H k+\  )Pk+l 

5.  True  State  Update 

^4  =  V1_^i2  “^2  -^3 
q  =  Sq®q 
d>  =  CO  +8co 

x  =  [q,  q2  q3  qA  cbx  cby  6) J 


4+i 

®a+i  =  4-  +  J  7  1  [iV  -  ®  x  7<uf/t 

4 

It  is  important  to  note  several  aspects  of  the 
6-state  EKF  process  at  this  point.  In  addition, 
key  differences  from  the  7-state  EKF  will  be 
highlighted.  Notice  that  both  covariance  and  the 
true  state  are  predicted  in  the  propagation  cycle. 
However,  all  matrices  involved  in  the  covariance 
propagation  are  6x6,  which  significantly 
reduces  the  computational  load  upon  the  filter. 

Although  this  correction  cycle  may  appear 
very  similar  to  that  of  the  7-state  EKF,  they  are 
markedly  different.  In  the  7-state  EKF,  the  state 
vector  is  both  propagated  and  directly  updated. 
That  is  to  say,  after  propagation  of  the  state 
vector,  the  correction  cycle  acts  directly  upon  the 
state  vector.  The  6-state  EKF  process  is  slightly 
more  complex.  The  propagation  cycle  of  the  6- 
state  EKF  inputs  the  true  state  and  propagates 


6-State 

Extended  Kalman  Filter  Cycle 


(.+  (f)  c 


A  -  Magnetometer 

-  Measurement 

T  Measurements 

'  Prediction 

-^L-  -  Sun  Sensor 

Input  (IGRF) 

*  Measurements 

*  Correction  occurs 
every  5  seconds 
for  FS3 


Figure  4.  6-State  EKF  Cycle 
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this  vector  forward  in  time.  The  auxiliary  state  vector  itself  is  not  propagated.  In  the  6-state  correction  cycle,  the 
auxiliary  (differential)  state  vector  is  calculated  and  then  utilized  to  update  the  true  state.  Therefore,  these 
calculations  primarily  involve  the  auxiliary  state.  In  this  cycle,  the  true  state  is  only  utilized  to  calculate  the  attitude 
matrix  and  in  the  last  step  to  update  the  true  state.  This  dependence  upon  the  auxiliary  state  rather  than  the  true  state 
plays  a  significant  role  in  reducing  the  computational  demand  of  the  6-state  EKF.  The  6-state  EKF  process  may  be 
represented  pictorially  as  below. 

The  6-state  EKF,  while  mathematically  more  complex,  reduces  the  covariance  matrix  (h),  state  transition 
matrix  (® ) ,  F  matrix,  and  the  process  noise  covariance  matrix  (Q)  from  7x7  matrices  to  6  x  6  matrices.  In  effect, 
this  eliminates  13  elements  for  each  matrix.  In 
addition,  the  observation  matrix  (h)  is  reduced 
from  a3x7toa3x6,  and  the  Kalman  gain  matrix 
(_K)  is  reduced  from  a  7  x  3  to  a  6  x  3.  This 
reduction  in  size  is  the  great  benefit  of  the  6-state 
EKF.  By  assuming  normalization  and  linearization 
of  the  quaternion  differential  error,  a  much  less 
computationally  intense  EKF  is  possible.  Note  that 
computational  demand  and  processing  speed  have 
not  yet  been  empirically  determined  for  either 
filter.  However,  the  table  below  demonstrates  the 
sheer  magnitude  of  the  reduction  in  the  number  of 
matrix  elements,  which  should  correlate  with  the 
actual  computational  speed. 

V.  Filter  Implementation 

In  order  to  examine  its  operability  and  performance,  both  the  6-state  and  7-state  EKF  were  programmed  in  the 
computer  language  C.  The  data  presented  hereafter  is  primarily  a  summary  of  conclusions  reached  based  upon  a 
series  of  analyses.  It  is  intended  to  demonstrate  the  operability  of  the  implemented  EKFs  as  well  as  to  provide  a 
basis  for  comparison  of  these  EKFs  with  one  another.  In  addition,  issues  that  are  important  for  practical 
implementation  yet  unsuitable  for  the  EKF  theory  discussion  will  be  presented  here. 

In  order  to  test  the  EKF  before  launch,  a  simulation  of  the  operating  environment  of  the  satellite  must  first  be 
developed.  This  simulation  is  required  in  order  to  generate  realistic  measurements  for  the  EKF  to  utilize  as  input. 
The  simulation  utilized  to  generate  the  input  measurements  for  all  analyses  detailed  herein  is  a  third  generation 
flight-tested  orbit  propagator.  It  has  been  used  on  various  satellites  engineered  by  Surrey  Satellite  Technology  Ltd. 
This  orbit  propagator  generates  simulated  magnetometer  and  sun  sensor  inputs  in  two  different  regards.  First,  the 
orbit  propagator  generates  these  magnetometer  and  sun  sensor  inputs  in  the  local  orbital  (with  respect  to  inertial) 
frame.  These  filter  inputs  are  what  is  considered  the  orbit  propagator  ‘predicted’  values.  This  input  from  the 
simulation  will  be  necessary  during  actual  satellite  operations.  The  second  set  of  input  data  generated  by  the  orbit 
propagator  is  a  set  of  ‘measured’  values.  These  values  simulate  measurement  input  from  the  magnetometer  and  sun 
sensor,  and  so  this  set  of  input  is  in  the  body  (with  respect  to  inertial)  frame.  Since  this  second  set  of  inputs,  the 
‘measurement’  inputs,  is  only  simulating  values  that  will  come  from  onboard  sensors  during  the  actual  operation  of 
the  satellite,  this  data  will  not  be  generated  by  the  simulator  during  actual  satellite  operations. 

In  addition,  a  standard  of  comparison  is  necessary  in  order  to  determine  the  veracity  of  the  EKF  results.  Another 
well-tested  program  developed  by  Surrey  Satellite  Technology  Ltd.  was  utilized  for  this  purpose.  This  simulation  is 
an  attitude  propagator,  which  models  the  actual  satellite  dynamics  and  outputs  Euler  angles  and  Euler  rates  over  a 
specified  period  of  time.  This  simulation  simply  uses  Euler’s  Moment  Equations  and  the  quaternion  dynamic 
equation  to  propagate  expected  angles  and  rates.  Due  to  the  construction  of  this  model,  it  is  quite  simple  to  simplify 
the  model  to  discount  all  disturbance  torques  etc.  or  to  precisely  model  gravity  gradient  (including  boom 
deployment),  magnetic  (including  commanded  magnetic  moment),  drag,  reaction  wheel  effects,  and  other 
disturbance  torques. 

It  is  appropriate  to  mention  several  practical  considerations  of  both  EKFs  implementation  at  this  point.  FS3  will 
be  operating  in  a  35°  inclined  circular  LEO  at  an  altitude  of  560  km.  The  spacecraft  is  estimated  to  have  a  mass  of 
47.2  kg  and  essentially  be  configured  as  a  cube  0.46  m  on  a  side  with  a  2.84  m  (to  the  center  of  gravity)  gravity 
gradient  boom  and  7.8  kg  tip  mass.  The  satellite  will  take  attitude  measurements  every  five  seconds  and  requires  1° 
attitude  knowledge  while  only  5°  attitude  control  accuracy  is  required.  The  microsatellite  is  optimally  nadir-pointing 
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Table  1.  EKF  Element  Comparison 
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(7x1) 
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(7x1) 
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(6x1) 
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(7x7) 

49 

(6x6) 
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(7x7) 

49 

(6x6) 

36 

F 

(7x7) 

49 

(6x6) 

36 

Q 

(7x7) 

49 

(6x6) 

36 

H 

(3x7) 

21 

(3x6) 

18 

K 

(7x3) 

21 

(6x3) 

18 

Total 

245 

Total 

193 

and  velocity  vector  tracking.  These  requirements  specify  several  operating  constants  for  the  EKFs,  specifically  the 
mean  motion  (,0  j.  the  measurement  input  frequency,  and  the  radius  of  the  orbit.  These  and  a  summary  of  other 

operating  constants  are  presented  here. 


r  =  6938.137  km 

m  =  0.0010924576567  rad/ 

0  /sec 

0 
0 

1.31 

//  =  3.986005 e5kmV  2 

/  sec 

A***  =  1  sec 

Note  that  the  assumed  integration  time  step  (Aiint )  is  1  second  unless  otherwise  specified.  In  addition,  the 
definition  of  the  body  frame  for  FS3  defines  the  unit  zenith  vector  (;«')as  shown.  The  inertia  tensor  is  boom- 
deployed.  These  operating  constants  apply  to  all  analyses  unless  otherwise  noted. 

Several  other  practical  considerations  merit  mention.  The  integration  in  the  state  propagation  is  accomplished  by 
numerical  integration.  This  cyclic  process  is  computationally  intensive.  Therefore,  to  reduce  the  computational 
demand  without  sacrificing  significant  accuracy,  an  Adam’s  2nd  order  numerical  integrator  will  be  implemented 
rather  than  a  more  complex  but  more  accurate  integrator.  Reference  the  integration  analysis  completed  by  the  author 
for  further  discussion  of  the  numerical  integrator.  Another  practical  consideration  concerns  the  nature  of  the 
computer  code.  Since  the  code  will  be  implemented  on  a  satellite,  the  code  must  be  extremely  robust.  Most 
importantly,  the  ADCS  computer  code  must  not  crash  the  satellites’  onboard  computer  at  all  expenses.  Therefore, 
error  checks  are  conducted  many  times  throughout  each  cycle  of  the  EKF.  If  an  error  is  detected,  the  ADCS 
algorithm  is  immediately  exited  and  a  message  relayed  to  satellite  operators  to  allow  human  operators  to  deal  with 
the  problem  rather  than  the  onboard  computer  crashing  as  a  result  of  the  error.  Finally,  the  nature  of  the  assumptions 
underlying  the  development  of  the  EKF  permits  a  small  amount  of  error  to  creep  into  the  quaternion  calculations.  In 
order  to  negate  this  error,  the  quaternions  must  be  normalized  after  every  instance  where  they  are  calculated.  This 
includes  both  the  quaternion  calculation  in  the  state  propagation  step  and  in  the  state  update  step. 

Finally,  several  other  initialization  parameters  deserve  an  explanation.  The  covariance  matrix  (p)  embodies  an 
approximate  error  associated  with  attitude  estimates.  The  first  three  (6-state)/four  (7-state)  diagonal  elements  of  the 
covariance  matrix  represent  the  estimated  error  of  the  quaternions,  while  the  next  three  diagonal  elements  give  the 
estimated  error  of  the  angular  rates.  It  is  important  to  note  that  the  covariance  matrix  is  merely  an  initialization;  over 
time,  the  matrix  changes  as  the  EKF  converges.  The  process  noise  covariance  matrix  ( Q )  is  another  initialization 
parameter  that  deserves  mention.  The  process  noise  covariance  matrix  contains  information  relating  an  estimate  for 
the  error  associated  with  the  system  equations.  From  a  strict  mathematical  standpoint,  the  process  noise  covariance 
matrix  also  changes  with  time.  However,  these  changes  can  be  ignored  due  to  their  small  magnitude.  The  first  three 
(6-state)/four  (7-state)  diagonal  elements  of  the  process  noise  covariance  matrix  represent  the  error  associated  with 
the  quaternion  dynamic  equation,  while  the  next  three  diagonal  elements  are  the  estimated  error  associated  with 
Euler’s  moment  equations.  Note  that  to  rigorously  implement  this  matrix,  these  error  estimates  are  the  subject  of 
several  mathematical  operations.  The  purpose  of  these  operations  is  beyond  the  scope  of  this  paper,  but  for 

reference,  the  process  noise  covariance  matrix  error  estimates  for  all  cases  is  \e  4  for  both  quaternions  and  rates. 
Lastly,  the  measurement  noise  covariance  matrix  (R )  contains  the  error  expected  to  be  associated  with 
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measurements.  Note  that  the  measurement  noise  covariance  will  change  as  the  sun  sensor  is  switched  on  and  off. 
However,  the  measurement  noise  covariance  is  otherwise  constant  over  time. 

VI.  Extended  Kalman  Filter  Analysis 


A.  7-State  Analysis 

The  following  initialization  parameters  were  utilized  for  7-state  analysis. 
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The  Kalman  filter  was  run  for  a  single  twenty-four  hour  period,  with  the  initial  conditions  detailed  previously. 
During  this  period,  the  sun  sensor  was  switched  off.  In  other  words,  all  of  these  graphs  present  the  case  where 
magnetorquers  are  the  sole  attitude  determination  sensors.  In  addition,  all  measurements  are  being  normalized  to 
negate  possible  effects  of  the  vector  magnitude.  Finally,  gravity  gradient  disturbance  torque  was  the  only 
disturbance  modeled. 

The  angular  estimation  error  is  presented  graphically  below.  Note  the  distinctive  ‘pulsating’  effect  of  the  7  State 
angular  estimation  error  plot.  These  pulses  arise  from  the  magnetic  field  as  the  satellite  orbits  above  the  Earth.  In 
fact,  if  the  pulses  are  tallied,  there  are  fifteen,  which  corresponds  to  the  number  of  times  the  satellite  orbits  the  earth 
in  a  single  day.  (At  an  altitude  of  560  km,  there  are  15.02  orbits  in  solar  day  and  14.98  orbits  per  sidereal  day). 
These  pulsations  are  therefore  expected,  due  to  the  variation  in  the  magnetic  field  around  the  Earth  and  its 
interaction  with  the  spacecraft  dipole.  In  addition,  the  7-state  rate  estimation  error  is  presented  here.  Tabulated  error 
magnitudes  are  presented  below  the  graphs. 
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Figure  6.  7-State  Angular  Est.  Error  (Detail) 


Figure  8.  7-State  Rates  Est.  Error  (Detail) 


For  the  graphs  presented  above,  notice  that 
the  filter  takes  on  the  order  of  1-1.5  hours  to 
converge.  This  represents  the  time  it  takes 
from  switching  the  filter  on  to  the  time  at 
which  the  filter  provides  an  accurate  attitude 
estimate.  The  tabulated  values  will  primarily 
be  utilized  for  comparative  purposes  in 
relation  to  the  6-state  results.  Note,  however, 
that  the  magnitude  of  the  RMS  error  results 
indicates  that  the  angular  error  is 
approximately  0.16  and  the  rate  error  is 
about  0.0018,  both  in  degrees.  These  results 
fit  within  the  bounds  specified  by  the 
derived  attitude  requirements. 


Table  2.  7-Sate  Error  Compilation 


Avg  d 

STD  d 

RMS  d 

Roll  (deg): 

1.28E-03 

6.99E-02 

6.99E-02 

Pitch  (deq): 

-7.25E-03 

3.69E-02 

3.76E-02 

Yaw  (deq): 

-1.62E-02 

1.38E-01 

1.39E-01 

Wx  (deg/s): 

-2.04E-05 

1.52E-04 

1.53E-04 

Wy  (deg/s): 

-4.61  E-05 

1.35E-04 

1.42E-04 

Wz  (deg/s): 

-1.83E-06 

1.74E-03 

1.74E-03 

Mag  of  Err. 

Mag  of  Err. 

Mag  of  Err. 

Angles  (deg): 

-7.40E-03 

1.59E-01 

1.60E-01 

Rates  (deg/s): 

-2.28E-05 

1.75E-03 

1.76E-03 
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B.  6-State  Analysis 

The  following  initial  parameters  were  utilized  for  the  6-state  EKF. 
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The  6-state  angular  estimation  error  is  presented  below.  Notice  that  the  6-state  angular  estimation  error  plot  does  not 
demonstrate  periodic  variation  as  the  7-state  angular  estimation  error  plot  did.  This  is  somewhat  unexpected,  as  it 
indicates  that  the  6-state  EKF  is  able  to  produce  slightly  more  accurate  angular  attitude  estimate  than  the  7-state 
EKF.  Further  testing  is  required  to  test  the  veracity  of  this  claim.  The  6-state  rate  estimation  error  plots  are  presented 
below  as  well.  Tabidated  errors  are  presented  below  the  graphs. 
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RUconSa3:  ADCS  Log  File 
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Figure  10.  6-State  Angular  Est.  Err.  (Detail) 


Figure  12.  6-State  Rates  Est.  Err.  (Detail) 


Notice  that  the  magnitude  of  the  RMS  error  is  within  the  derived  attitude  knowledge  requirements  demanded  by 
the  FLAPS  payload  (±  1  ).  In  addition,  note  that  the  magnitude  of  the  RMS  error  of  the  6-state  EKF  and  the  that  of 
the  7-state  EKF  are  almost  exactly  identical. 

C.  Analysis  To  Do 

Much  work  remains  to  be  accomplished  from  the  filtering  standpoint  of  FS3. 

•  Program  a  constant  gain  filter  for  analysis  and  comparison 

•  Perform  optimization  analyses 

o  Initial  Covariance  Matrix  (P) 
o  Observation  Noise  Covariance  Matrix  (R) 
o  Process  Noise  Covariance  Matrix  (Q) 
o  Boundaries  for  effects  of  measurement  noise 

•  Minimize  code  size,  memory  allocation,  computational  demand, 

•  Maximize  computational  speed,  redundancy,  robustness 

Once  all  of  these  tasks  are  accomplished,  the  selected  filter  will  be  tested  on  data  derived  from  PICOSat.  PICOSat  is 
a  United  States  Air  Force  satellite  that  is  solely  controlled  by  Air  Force  Academy  cadets  trained  to  do  so.  Data  from 
PICOSat  will  be  utilized  due  to  the 
similarity  between  PICOSat  and  FS3. 

PICOSat  is  a  nadir-pointing,  velocity  vector 
tracking  microsatellite  with  similar  mass  and 
inertia  tensor  values.  In  addition,  PICOSat 
utilizes  a  gravity  gradient  boom  and 
magnetorquers  for  control,  with  sun  sensors 
and  magnetometers  for  attitude  sensors. 

From  the  ADCS  standpoint,  these  qualities 
make  PICOSat  very  closely  related  to  FS3. 

Therefore,  telemetry  will  be  downloaded 
from  the  satellite  and  then  entered  into  both 
EKFs  to  determine  if  their  output  accurately 
predicts  the  attitude  dynamics  of  PICOSat. 

This  test  will  lend  credence  to  the  validity  of 
the  software. 

VII.  Conclusions 

The  ADCS  requirements  of  various  payloads  on  FS3  are  stringent  enough  to  demand  some  type  of  data 
processing  in  order  to  meet  attitude  determination  requirements.  This  paper  detailed  Kalman  filtering,  and  more 
specifically,  the  7-state  and  6-state  Kalman  filters.  Both  filters  proved  to  meet  the  ADCS  attitude  determination 
requirements  successfully  with  little  difference  in  achieved  accuracy.  However,  the  6-state  filter  places  much  less 
computational  demand  upon  the  on-board  computer.  Based  upon  this  data,  the  6-state  filter  is  a  more  logical  choice 
for  the  FS3  ADCS  filter.  However,  there  is  still  much  analysis  that  needs  to  be  completed  before  a  final  verdict 
might  be  reached. 


Table  3.  6-State  Error  Compilation 


AVG  d 

STD  d 

RMS  d 

Roll  (deg): 

6.45E-03 

3.07E-02 

3.13E-02 

Pitch  (deg): 

-1.62E-03 

4.70E-02 

4.71E-02 

Yaw  (deg): 

-3.24E-02 

1.43E-01 

1.47E-01 

Wx  (deg/s): 

1.04E-05 

1.53E-04 

1.53E-04 

Wy  (deg/s): 

-5.45E-05 

1 .49E-04 

1.58E-04 

Wz  (deg/s): 

3.68E-05 

1 .94E-03 

1.94E-03 

Mag  of  Err. 

Mag  of  Err. 

Mag  of  Err. 

Angles  (deg): 

-9.20E-03 

1.54E-01 

1.57E-01 

Rates  (deg/s): 

-2.43E-06 

1.95E-03 

1.96E-03 
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Appendix  A.  Expanded  7-State  Results 

FalconSal3:  ADCS  Log  File 
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Figure  13.  7-State  Angular  Estimation  Error,  Expanded  View 

FalconSat3:  ADCS  Log  File 

7  State  Angular  Estimation  Error  (Detail) 
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Figure  14.  7-State  Angular  Estimation  Error  (Detail),  Expanded  View 
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FalconSat3:  ADCS  Log  File 

7  State  Rates  Estimation  Error 
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Figure  15.  7-State  Rates  Estimation  Error,  Expanded  View 
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Figure  16.  7-State  Rates  Estimation  Error  (Detail),  Expanded  View 
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Appendix  B.  Expanded  6-State  Results 

FaloonSat3:  ADCS  Log  File 

6  State  Angular  Estimation  Error 


Figure  17.  6-State  Angular  Estimation  Error,  Expanded  View 

FalconSat3 :  ADCS  Log  File 

6  State  Angular  Estimation  Error  (Detail) 


Figure  18.  6-State  Angular  Estimation  Error  (Detail),  Expanded  View 
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FalconSat3:  ADCS  Log  File 

6  State  Rates  Estimation  Error 
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Figure  19.  6-State  Rates  Estimation  Error,  Expanded  View 


FalconSal3:  ADCS  Log  File 
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Figure  20.  6-State  Rates  Estimation  Error  (Detail),  Expanded  View 
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